/*
* This file is part of RoboDS (http://code.google.com/p/robods/)
* Copyright (C) 2007 Blakharaz
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* as published by the Free Software Foundation; either version 2
* of the License, or (at your option) any later version.
* 
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
* GNU General Public License for more details.
* 
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA
*/

#include "DsMovementJob.h"

#include "Logger.h"
#include "DsRobot.h"

namespace robo
{

    DsMovementJob::DsMovementJob(
        Robot* robot, Vector2 startPos, Vector2 targetPos, unsigned short frames)
    : 	AbstractJob(frames),
	    mRobot(robot)
    {
	    mStartPosition = startPos;
	    mTargetPosition = targetPos;
	    mStepping.X = 16. * (float)(mTargetPosition.X - mStartPosition.X) / (float)mFramesEnd;
	    mStepping.Y = 16. * (float)(mTargetPosition.Y - mStartPosition.Y) / (float)mFramesEnd;
    }

    DsMovementJob::~DsMovementJob()
    {
    }

    bool DsMovementJob::advanceOneFrame()
    {
	    mFrameCounter++;
    	
	    //Vector2 curPos = mStartPosition;
	    //curPos.X += (int)((float)mFrameCounter * mStepping.X);
	    //curPos.Y += (int)((float)mFrameCounter * mStepping.Y);
	    //mRobot->setPosition(curPos.X, curPos.Y);
    	
	    if (mFrameCounter >= mFramesEnd)
	    {
		    mRobot->setMapPosition(mTargetPosition.X, mTargetPosition.Y);
		    Logger::getSingleton()->log("move robot to (%d, %d)", mTargetPosition);
	   	    return true;
	    }

	    return false;
    }

}
